#include <stdio.h>
#include <stdint.h>
#include <stdbool.h>
#include <unistd.h>
#include "ohos_init.h"
#include "cmsis_os2.h"
#include "wifiiot_gpio.h"
#include "wifiiot_gpio_ex.h"
#include "wifiiot_i2c.h"
#include "wifiiot_i2c_ex.h"
#include "motor.h"

bool Motor_IsRunning = false;

void Motor_Init(void)
{
    GpioInit();
    IoSetFunc(WIFI_IOT_IO_NAME_GPIO_7, WIFI_IOT_IO_FUNC_GPIO_7_GPIO);
    GpioSetDir(WIFI_IOT_IO_NAME_GPIO_7, WIFI_IOT_GPIO_DIR_OUT);
    GpioSetOutputVal(WIFI_IOT_IO_NAME_GPIO_7, 0);
}

void Motor_On(void)
{
    if(!Motor_IsRunning)
    {
        GpioSetOutputVal(WIFI_IOT_IO_NAME_GPIO_7, 1);
        Motor_IsRunning = true;
    }
}

void Motor_Off(void)
{
    if(Motor_IsRunning)
    {
        GpioSetOutputVal(WIFI_IOT_IO_NAME_GPIO_7, 0);
        Motor_IsRunning = false;
    }
}
